#include "Matrix.h"

float convertMod2Pi(float angle);

Vector offsetAnglesT(Vector katana_angles);

Vector de_offsetAnglesT(Vector ik_angles);

Vector offsetAnglesG(Vector katana_angles);

Vector de_offsetAnglesG(Vector ik_angles);


Vector de_offsetAnglesG_vel(Vector ik_angles);
